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5 METOD OCH SYSTEM >6R ATT PROGRAMMERA 
EN INDUSTR1ROBOT 

TEKIMISKT OMRADE OCH TIDIGARE TEKNIK 

10 Forellggande uppfinnlng avser en metod, ett system, ett dator- 
program och ett datorlasbart medium innefattande ett datorpro- 
gram for att programmera en industrirobot att forflytta sig relativt 
definierade positioner pa ett objekt, varvld programmerlngen ba- 
serar slg pa en geometrisk modell av objektet. Objektet kan an- 

15 tingen vara ett arbetsobjekt, en fixtur, ett gripdon eller ett verk- 
tyg. Uppfinningen ar sarskilt anvandbar i eamband med pro- 
grammering av en robotbana innefattande ett antal definierade 
positioner pa objektet, till exempel for malning, slipnlng, frasning, 
svetsning eller limning. Emellertid ar uppfinningen aven tillamp- 

20 bar f6r programmering av enskilda positioner, till exempel fdr 
punktsvetsning eller objektgripning. 

Det ar kand teknik att programmera en industrirobot med an- 
vandning av en CAD-modell av objektet. Robotbanans positioner 

25 erhalls fran CAD-modellen. Dessa positioner maste emellertid 
korrigeras med avseende p& geometriska och kinematiska fel bos 
roboten, verktyget och arbetsobjektet. Exempel pa sadana fel ar 
avvlkelser mellan det verkliga objektet och modellen, fel I robo- 
ten placering relativt omgivningen, armlangdfel, axelattitydfel och 

30 ' axeloffsetfel hos roboten. F5r att utfdra en sadan korrigering idag 
/ maste roboten vara kalibrerad med hog noggrannhet. 

» 

I* Ett stort problem vid dagens robotanvandnlng ar robotnoggrann- 

heten. Att bygga en hdgprecisionsrobot dar varje komponent ar 
35 noggrant uppmStt och dar robotens kinematikparametrar kalibre- 
ras med lasermatsystem blir mycket dyrt. Kalibrerlng med laser- 

: : och kameramatsystem anvands dock i vlss utstrackning, men en- 
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dast av storre biltillverkare som har ekonomi och personaf^S?* 6 
klara av denna komplexa teknik. Sa lange det inte Anns en enkel 
och blllig metod att kalibrera och programmera industrirobotar 
kommer dessa endast att kunna anvandas i fdretag med tillrack- 
5 liga finansieila och personalia resurser. 

ANDAMAL OCH SAMMANFATTNING AV UPPFINNINGEN 

Andamalet med foreliggande uppfinning ar att tlllhandahalla en 
10 metod och ett system som gor det.enkelt att kalibrera och pro- 
grammera en robot. 

Enligt en aspekt av uppfinningen uppnas detta andamal med en 
metod som kannetecknas av att den innefattar att ett flertal mat- 

15 punkter registreras och lagras, varvld var och en av matpunkter- 
na motsvarar en punkt pa det verkliga objektets yta uttryckt i na- 
got till roboten kopplat koordlnatsystem. Orientering och position 
hos en geometrisk modell av det aktuella objektet relativt ndmn- 
da till roboten kopplade koordinatsystem bestdmmes genom att 

20 den geometriska modellen av objektet och matpunkterna anpas- 
sas till varandra. Fdr atminstone nagra av matpunkterna berak- 
nas avvikelsen mellan matpunkterna och motsvarande punkter pa 
den geometriska modellen, och namnda definierade positioner 
Justeras baserat pa namnda beraknade avvikeiser. Matpunkterna 

25 motsvarar robotens positioner nfir en fdrutbestamd punkt pa ett 
verktyg, elier ett matorgan som motsvarar aktuellt verktyget, stSr 
i kontakt med olika punkter pa objektets ytor. 

Genom att anpassa uppm^tta varden f6r det verkliga objektet till 
30 en geometrisk modell av objektet och sedan korrigera positioner- 
na som roboten ska fdrflytta sig till i beroende av avvikelserna 
mellan de uppmStta vardena och modellen ar det mdjligt att kom- 
pensera en robotbana for samtliga geometriska och kinematiska 
fel i en robotcell. Bade kalibrering och programmering gors med 
35 en intuitiv metod utan att nagot robotprogram behdver skrivas 
eller visas for operatdren. NSgra extra matutrustningar f6r upp- 
matning av kinematikfel, verktygs koordinatsystem och objektko- 
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ordinatsystem behdvs inte. I stallet anvander operatdren roboten 
fdr uppmatningen och uppmatnlngen ar mycket enkel, operatdren 
pekar endast med verktyget eller ett sarskilt anpassat matorgan 
pa olika ytor och/eiler kanter hos det fdrem&l som skall kalibre- 
5 ras. Robotprogrammen kan sedan genereras automatiskt av ett 
CAD-system eller matas In med "lead through" av operatdren. 
"Lead through" Innebar att operatdren helt enkelt fdr verktyget I 
de banor som roboten sedan skall exekvera. Metoden kan aven 
anvandas f5r programmer! ng av fixturer, conveyrar och ahdra 
10 manipulatorer som skall samarbeta med roboten. 

Enllgt en fdredragen utfdringsform av uppfinnlngen innefattar me- 
toden att fdr ett antal ollka delar av objektet beraknas en eller 
flera karakteristiska parametrar baserat pa den geometriska mo- 

15 dellen fdr objektet. Till vllken del av objektet en matpunkt tillhor 
bestammes baserat pa namnda karakteristiska parametrar, och 
namnda anpassnlng av den geometriska modellen av objektet till 
matpunkterna innefattar att matpunkter som tillhdr en viss del av 
objektet anpassas till motsvarande del hos den geometriska mo- 

20 dellen. Med fdrdel innefattar namnda delar ytor och kantlinjer hos 
objektet. Med fardel innefattar namnda karakteristiska paramet- 
rar normalens riktnlngen relatlvt objektets yta och krdkningen hos 
objektets yta. Med fdrdel anpassas den geometriska modellen av 
objektet och matpunkterna till varandra genom att avstandet mel- 

25 Ian matpunkterna och motsvarande punkter pa den geometriska 
modellen av objektet minimeras. Genom att forst bestamma vll- 
ken del av objektet som varje matpunkt tillhor och sedan anpassa 
en del I taget underlattas anpassningen. 

30 Enligt en fdredragen utfdringsform av uppfinningen innefattar me- 
toden att geometriska modeller fdr ett antal olika objekt tlllhan- 
dahalls, fdr vart och ett av objekten beraknas ett antal karakteris- 
tiska parametrar baserat pa den geometriska modellen f6r objek- 
tet, och till vilket av objekten matpunkterna tillhor bestammes 

35 baserat pa matpunkterna och namnda karakteristiska parametrar. 
Med fdrdel innefattar namnda karakteristiska parametrar norma- 
lens riktningen relativt objektets yta och krdkningen hos objektets 
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yta. Pa sa satt identifierar systemet automatiskt objektet och av- 
g6r vllken geometrisk modell som ska anvandas vid programme- 
ringen. I en alternate utfdrlngsform matar operatoren sjalv In vll- 
ket bbjekt som ska anvanda9 vid programmeringen. 

5 

Enligt en foredragen utfdrlngsform av uppfinnlngen delas objek- 
tets ytor in i ett flertal delytor, var och en innehallande atmlnsto- 
ne en matpunkt, f6r delytorna beraknas en korrektionsvektor ba- 
serat pa awikelsen mellan matpunkten/matpunkterna i delytan 

10 och motsvarande punkt/punkter pa den geometriska modellen av 
objektet, och att namnda definierade positioner justeras baserat 
pa korrektionsvektorerna for de delytor som positlonerna tillhdr. 
Med fardel beraknas korrektionsvektorn for en delyta i form av ett 
medelvarde av avvikelserna f6r alia matpunkterna I delytan. En 

15 fordel med att dela in ytorna i delytor och att utnyttja fiera mat- 
varden f6r att berakna en korrektionsvektor f6r var]e delyta ar att 
brus och tlllfalliga vahationer I matvardena filtreras bcrt. 

Enligt en f6redragen utf6ringsform av uppfinnlngen delas objek- 
20 tets kantlinjer upp i ett flertal llnjesegment, som vart och ett in- 
nehaller atmlnstone en matpunkt, for llnjesegmenten beraknas en 
korrektionsvektor baserat pa awikelsen mellan matpunk- 
ten/matpunkterna I llnjesegment och motsvarande punkt/punkter 
pa den geometriska modellen av objektet, och att namnda defini- 
25 erade positioner justeras baserat pa korrektionsvektorerna for 
linjesegment I narheten av de definierade positionerna. Med f6r- 
del beraknas korrektionsvektorn for ett linjesegment i form av ett 
': medelvarde av avvikelserna for alia matpunkter som llgger pa lin- 

Jesegmentet. En fordel med att dela In kantlinjerna i linjesegment 
30 och utnyttja flera matvarden for att berakna en korrektionsvektor 
for varje delyta ar att brus och tlllfalliga varlatloner i matvardena 
filtreras bort. 

Enligt en foredragen utforlngsform av uppflnningen ar namnda 
35 definierade positioner definierade relativt den geometriska mo- 
dellen och de definierade positionerna transformeras till namnda 
till roboten kopptade koordlnatsystemet baserat pa den bestamda 
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orienteringen och positionen av den geometriska modellen rela- 
tivt det till roboten kopplade koordinatsystemet. I en utf6rings- 
form av uppfinningen sker definierlngen av positionerna som ro- 
boten ska genomlopa i ett CAD-system bch positlonerna laggs ut 

5 pa modellen av objektet. Positionerna ar saledes deflnierade I 
obiektkoordinatsystemet. F6r att det ska vara mdjligt att pro- 
grammera roboten sa att den fSrflyttar sig till dessa positioner 
maste positionerna transformers till nagot koordinatsystem som 
ar kopplat till roboten. Denna transformation ges av den tidigare 

10 bestamda orienteringen och positionen av den geometriska mo- 
dellen relativt det till roboten kopplade koordinatsystemet. 

Enligt ytterllgare en aspekt av uppflnningen uppnas detta anda- 
mal med ett datorprogram direkt inladdningsbart i en dators in- 

15 ternminne, innefattande instruktioner for att paverka en proces- 
sor att utfora stegen i forfarandet enligt uppfinningen n&r nftmnda 
datorprogram k6rs pa datorn. Datorprogrammet tillhandahalls ex- 
empelvis pa ett datorlasbart medium eller via ett natverk sasom 
Internet. Ett datorprogram enligt uppfinningen kan antlngen exe- 

20 kveras av en processor i robotens styrsystem, i CAD-systemet 
eller i en separat dator. 

Enligt ytterligare en aspekt av uppflnningen uppn&s detta anda- 
mal med ett datorlasbart medium innefattande ett datorprogram 
25 innefattande instruktioner for att paverka en processor att utfora 
stegen i forfarandet enligt uppfinningen nar namnda datorpro- 
gram k6rs pa datorn. 

Enligt ytterligare en aspekt av uppfinningen uppnas detta anda- 
30 mal med ett system for att programmera en industrlrobot att f6r- 
flytta sig relativt definierade positioner pa ett objekt, varvld sy- 
stemet innefattar en geometrisk modell av objektet, som kanne- 
tecknas av att systemet vidare innefattar det verkliga objektet, en 
industrlrobot, varvid det verkliga objektet och roboten ar anord- 
35 nade sa att det ar mdjligt att medelst roboten generera ett flertal 
matpunkter motsvarande oiika punkter pa det verkliga objektets 
yta uttryckt i ett till roboten kopplat koordinatsystem, en kallbre- 
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rinqsmodul anordnad att best&mma deii geometriska ^od^ens 
orienS och position relatlvt namnda till roboten kopplade ko- 
Se, medelst anpassning av matpunkterna till den geo- 
Ska f modeller, av objektet, en berakningsmodul anordnad for 
5 banning av avvlkelser mellan matpunkterna och 

punkter pa den geometriska rnodellen, och en justeringsmodul 
anordnad att juatera namnda definierade positioner baserat pa 
namnda beraknade avvikelser. 

10 Enligt en foredragen uttdringsform av uppfinnlngen innefattar sy- 
stemet ett matorgan anpassat for att vid matning sta I kontakt 
med objektets yta, varvld matorganet bar en centrumpunkt som 
motsvarar verktygscentrumpunkten (TCP) f6r aktuellt verktyg. F6r 
att underlatta matningen innelattar systemet ett matorgan, exem- 

15 pelvis i form av en matspets, som under matningen antingen er- 
satter verktyget eller satts pa verktyget. Matorganets TCP (Tool 
center point) skall vara densamma som verktygets TCP. 

Enligt en fbredragen uttdringsform av uppfinnlngen &r matorganet 
20 ar inrattat att vid kontakt med objektet avge en signal och att sy- 
stemet ar inrattat att som svar p& denna signal generera atmih- 
stone en matpunkt baserat pa robotens position. F6r att underlat- 
ta matningen genereras en signal nar matorganet ar i kontakt 
med objektets yta, varvid robotens position aviases vid kontakt 
25 meilan matorganet och objektets yta. 

KORT BESKRIVNING AV RITNINGARNA 

T Fdreliggande uppfinnlng ska nu forklaras med hjaip av olika sA- 

* . 30 som exempel beskrivna utfdringsformer och med hanvlsning till 
de blfogade ritningarna. 

;;i Figur 1 visar ett system for att programmera en Industrirobot 

enligt en uttdringsform av uppfinnlngen 



35 



Figur 2 visar ett blockdiagram fiver systemet enligt en utfo- 
ringsform av uppfinningen. 
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Figur 3 visar exempel pa definitioner fdr objektklassificering 
och matpunktsklassificering. 

5 Figur 4 illustrerar klassificerlngsmodulens funktlon. 

Figur 5 illustrerar kalibrerlngsmodulens funktion. 

Flgurerna 6-10 visar justeringsmodulens funktion. 

10 

Figur 1 1 visar ett exempel pa programeditering. 

Flgur 12 visar ett utfflringsexempel med rumsfast TCP. 

15 Figur 13 visar verktygskallbrering. 

Flgur 14 visar ett exempel for applikationen bagsvetsning. 

DETALJERAD BESKRIVNING AV FCREDRAQNA UTF6RINGS- 
20 FORMER 

Flgur 1 visar ett exempel p& ett system for programmerlng av en 
industrlrobot enligt uppfinnirigen. Systemet innefattar en Industri- 
robot 1, i fortsattnlngen kallad roboten. vilken i sin tur innefattar 
25 en manipulator 2 och ett styrsystem 3 for styrning av robotens 
rdrelser. Styrsystem som inneh&ller en modell av robotens kine- 
matik. Systemet innefattar vidare ett arbetsobjekt, pa vilken robo- 
ten ska utfdra nagon form av process, exempelvis svetsning, 
malning eller slipning. Vidare innefattar systemet en dator 5, i 

:-. 30 vilken mjukvaran som tillhdr uppfinningen finns lagrad och dar 
mjukvaran exekveras. Roboten, som visas i figuren, ar en sexax- 

;;* lig industrirobot och innefattar en bas 7, vilken ar fast monterad 

mot ett underlag och ett stativ 8, vilket ar vridbart i forhallande till 
basen runt en fdrsta axel. I stativets 6vre ande ar en forsta ro- 

: : 35 botarm 9 vridbart lagrad i fdrhallande till stativet runt en andra 
axel. I den fdrsta armens ytterande ar en andra arm 10 vridbart 
lagrad I forhallande till den forsta armen runt en tredje axel. Den 
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andra robotarmen Innefattar tva delar, varvld den ^ *f " ^ 
vridbar i f6rhallande till den tare delen runt en fjarde axel. Den 
andra armen 10 uppbir i sin yttre ande en tilt 11. vllken&r vrid- 
bar runt en femte axel. Roboten Innefattar ocksa ett verktygsfas- 
5 te 12, som ar roterbart I fdrhallande till tilten runt en sjatte axel. 

Pa verktygsfastet ar ett matorgan monterat, vilken Innefattar en 
matspets 14, Den yttre anden av matorganet ar formad som en 
spets och utgfir matspetsen 14. Matspetsens ytterata del ar av- 
10 sedd att brlngas I kontakt med ytan hos objektet 4. Matorganets 
TCP ("Tool Center Point") ska vara densamma som TCP for det 
verktyg som ska anvandas vld processen. Alternatlvt kan mat- 
spetsen monteras dlrekt pa det verktyg som ska anvandas. Vld 
bagsvetsning monteras matspetsen pa svetsplstolen med den yt- 

15 tersta delen av spetsen I den position dar svetsstralen normalt 
slutar. Vid polering monteras en "dummy"-axel fdrsedd med en 
matspets i spindelhallaren I stallet f6r polerverktyget. Matspet- 
sens TCP ska vara densamma som TCP fdr polerverktyget, vilket 
normalt ar i centrum av polerskivan. For att underlatta matnlngen 

20 kan en elektrlsk signal kopplas mellan matspetsen och det aktu- 
ella objektet, varvld robotposltlonen lases av, da kontakt slutes, 
d.v.s. 6k matspetsen ar I kontakt med den yta oiler kant som ska 
matas. 

25 Matningen gar till sa att matspetsen 14 fors fram och tillbaka 
over de ytor hos objektet som ar atkomllga. I fortsattningen be- 
namns en yta hos ett objektet f6r objektyta. Verktygsorientering- 
en hails darvid ungefar pa samma satt som ar aktuellt fdr pro- 
cessen, exempelvls I fallet med polering medelst rondell vinkel- 
30 ratt mot de ytor som mates. Det ar viktigt att verktygsorlentering- 
en halls ungefar som i den aktuella processen f6r att ratt klnema- 
tiska fel ska kompenseras. Ju fler matpunkter som erhalles desto 
battre bllr kalibrerlngen. For att erhalla ett tlllfredstallande resul- 
tat bfir atminstone tre matpunkter erhallas per objektyta och at- 
35 mlnstone tva matpunkter per kantllnje hos objektet. Robotens 
styrsystem beraknar matpunkternas position i robotens baskoor- 
dinatsystemet. I en alternativ utfdringsform beraknar styrsyste- 
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met pbsltionen i nAgot annat koordinatsystem. som ar kopplat till 
roboten. Berakningen sker med hjalp av en kinematlsk model! for 
roboten. 

5 Det ar en fordel om roboten har en reglermod far manuell ("lead- 
through") positionering. Detta Innebar att robotoperatdren med 
latthet kan positlonera och orientera det verktyg eller det arbets- 
objekt som roboten uppbar genom att med handerna ta tag i 
verktyget eller objektet. En mojllghet att direkt manipulera en ro- 
10 bot, d.v.s. utan programmeringslada med "joystick" ar att Infora 
en kraftsensor kopplad till en regleralgoritm i styrsystemet som 
omformar operations handkraft till robotrdrelser. F6r detta an- 
damal maste roboten vara helt saker, sa att operatoren ej kom- 
mer till skada vid ett eventuellt tel. En mojllghet att uppfylla detta 
15 krav ar att anvanda en parallellkinematlsk robot med sa lag arm- 
vikt att roboten vid maxlmalt uppnaellg motoreffekt och hastlghet 
Inte allvarligt kan skada operatdren. Samtidigt bdr i styrsystemet 
finnas redundanta system f6r feldetektering. 

20 Figur 2 vlsar \ form av ett blockschema de Ingaende modulerna i 
systemet. F6rutom roboten 1, matspetsen 14 och objektet 4 inne- 
fattar systemet en CAD-modul 15, som tlllhandahaller geometris- 
ka modeller av olika arbetsobjekt och verktyg, en klasslflce- 
ringsmodul 16, vllken i sin tur Innefattar en delklassificerlngsmo- 

25 dul 16a, som bestammer till vllken del av objektet en viss mat- 
punkt hdr och en objektklassificerlngsmodul 16b, som bestammer 
till vllket objekt eller verktyg m&tpunktera h6r, en kallbreringsmo- 
dul 17, som bestammer den geometriska modellens orientering 
och position relativt roboten, en berakningsmodul 18, som be- 

30 stammer avvikelsen mellan matpunkterna och motsvarande punk- 
ter pa den geometriska modellen samt beraknar korrektionsvek- 
torer som sedan anvandas for att korrigera de definierade posi- 
tioner till vilka roboten ska fdrflyttas under utfdrande av proces- 
ses samt en justeringsmodul 19, som ar anordnad att justera de 

35 definierade positioner pa objektet till vilka roboten ska forflyttas i 
beroende av korrektionsvektorerna. 
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Matpunkternas position i robot nagot av robotens koordinatsy- 
stemet beraknas i robotens styrsystem baserat pa den kinematls- 
ka modellen och robotaxlarnas lagen vld tidpunkten fdr matn ing- 
©n. Matpunktema overfdrs sedan fran styrsystemet till klassifice- 
5 ringsmodulen 16 f&r vidare bearbetning. 

I CAO-modulen 15 finns geometriska modeller av ett antal ollka 
arbetsobjekt och verktyg som ska anv&ndas I den aktuella robot- 
cellen. De geometriska modellerna utgdrs av CAD-modeller. I 

10 CAD-modellerna kan vllken punkt som heist pa objektets yta be- 
raknas fran exempelvis "splineMunktioner, linjeekvationer eller 
ytekvationer. I varje punkt pa objektets yta ar det mdjllgt att, med 
hjaip av kringtiggande punkter pa objektets yta, berakna sadana 
karakterlstlska parametrar som ytnormalens riktnlng och ytkrdk- 

15 ningen i olika riktningar. I diskontinuerliga overgangar mellan oli- 
ka ytor kan punkter I kantlinjer ges speciella karaktaristika, sa- 
som llnjeriktning, linjekrokning och beteckning hos anslutande 
plan. Detta utgor exempel pa mdjligheter att g6ra ytpunkter uni- 
ka. 

20 

For att gftra ytor unika kan parametrar som karaktariserar punk- 
terna pa ytorna anvandas, till exempel medelnormalen, sprid- 
ningen i normalrlktning, ytans area, ytans medelkrflkning. Pa 
samma satt kan kantlinjer goras unika med parametrar for medel- 
25 riktnlng, medelkrdkning, linjeiangd etc. F6r ett helt objekt kan re- 
lationerna mellan de definierade ytorna och kantlinjerna anvan- 
das, till exempel vilka normalriktningar som ar representerade, 
hur ytnormalerna ar relaterade till varandra, vilka ytor kantlinjer- 

T na avgransar och relationen mellan olika kantlinjers riktnlng. 

k 30 

... Figur 3 vlsar nagra definitioner f6r objektklassiflcering. Objektet 

f 34 har ett antal objektytpr 20 och ett antal kantlinjer 21. -PA ob- 

::! jektytan finns ett antal matpunkter 22 utmarkta med kryss. I flgu- 

::: : ren finns ett objektkoordinatsystem 23 utsatt. Objektkoordinatsy- 

- : 35 stemet ar kopplat till objektet och alia punkter pa objektet ar rela- 
V terade till objektkoordinatsystemet. 
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Mdjliga klassificeringsmatt fdr objektytor Sr: . . ktutor 

- Model, max ooh min normalriktning relativt andra objektytor. 
-Medal max och min krdkningsvinkel i olika rlktningar relafvt 

5 "objak'ylans Sngdpunkte.age och araa relativt andra objaktytor 

- Langder hos framraknade kantlinjer som ansluter till objektytan. 

Mdjliga klassificeringsmatt fdr objekt &r: 

- Klasslficeringsmatten fdr de ingaende objektytorna. 
10 - Klassificeringsmalten for kantllnjer. 

- Spektrum av klassificeringsmatt fdr m&tpunkter, 

I figur 3 visas ocksa ett exempel pa krdkningsmatt I form av en. 
konvex krdkningsvinkel 25 och en normalvektor 26 till en mat- 
15 punkt P. 

Mdjliga klassificeringsmatt fdr matpunkter i ett plan §r: 

- Normalriktning relativt andra matpunkter. Fdr att bestamma nor- 
malriktningen kravs minst tva hjalpmatpunkter. 

20 - Krdkningsvinkel i minst en riktning. Fdr att bestamma krdk- 
ningsvinkeln kravs minst en hjalpmatpunkt. 

- Koefficienter i en "spline" genom punkten. Fdr att bestamma 
dessa koefficienter kravs minst tva hjalppunkter. 

- Avstand till andra matpunkter, t.ex. till extrempunkter. 

25 

Mdjliga klassificeringsm&tt fdr kantlinjer som ber&knas av skar- 
nlngen mellan identifierade plan an 

: Tangentriktningen relativt andra kantlinjepunkter. Fdr att be- 
etamma tangentriktningen kravs minst en hjalpmatpunkt. 
30 - Krdkningsvinkel langs kantlinjen. Fdr att bestamma krdknings- 
vinkeln kravs minst en hjaippunkt pa kantlinjen. 

- Koefficienter in en "spline" genom n&rliggande kantlinjepunkter. 
Fdr att bestamma dessa koefficienter kravs minst tva hjalppunk- 
ter. 

35 - Avstand till andra kantlinjepunkter, t.ex. till extrempunkter. 
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I klasslficeringsmodulen genereras automatlskt med data fran 
CAD-modu!en tabeller 6ver karakterlstlska parametrar f6r ytpunk- 
ter, ytor och kantlinjer hos de aktiiella CAD-modetlema. Med 
hjalp av dessa parametrar klassificerar denna modul de matpunk- 
ter som lases in fran roboten, d& matspetsen fir i kontakt med det 
verkliga objektets ytor. Pa detta satt kommer de uppmatta punk- 
terna att markas upp med vilka objekt, ytor och kantlinjer de till- 
hor. Da klasslflcerlngen ar saker, lamnas dessa data Over till ka- 
libreringsmodulen. 



Figur 4 vlsar klassificerlngsmodulens 16 funktion narmare. I flgu- 
ren visas ett antai matpunkter 30 betecknade med x i figuren, vil- 
ka motsvarar positioner pa det verkliga objektet. Matpunkterna P„ 
ar uppmatta med robotkinematiken 31. Robotens styrsystem be- 

15 raknar matpunkternas position I robotens baskoordinatsystemet 
32. Beraknlngen sker med hjalp av en kinematlsk modell f6r ro- 
boten. I CAD-modulen flnns ett objektkoordinatsystem 23 definie- 
rat och en CAD-modell 34 av objektet finns beskriven i objektko- 
ordinatsystemet. Matpunkterna klassificeras vilket innebar att det 

20 avgors vilket objekt matpunkterna tillhdr och viiken objektyta eller 
kantlinje matpunkterna tlilhor. Saledes bestams f6r varje mat- 
punkt till vllken objektyta eller kantlinje matpunkten h6r. En tabell 
tas fram for varje objektyta, dar ingaende matpunkter listas. Det- 
ta innebar att matpunkterna 36 placeras ut pa ytorna pa CAD- 

26 modellen. Denna utplacerlng kan farenklas avsevart om kravet 
att systemet ska kanna igen objektet ej ar viktigt, utan att syste- 
met kanner till vilket objekt som ar aktuellt och visar operatoren 
pa en bildskarm, viika ytor eller kanter som han ska mata In med 
roboten. Exempelvls kan operatbren forse systemet med Informa- 

30 tion om vilket objekt som ska kalibreras. 

Mer i detalj hur klassiflcering och igenkanning av objekt kan utfo- 
ras finns att lasa i skriften: "CAD-based object recognition for a 
sensor/actor measurement robot" av Claus Brenner, Jan Bdhm 
35 och Jens GGhring. Denna skrift fanns utlagd den 11 februari 2003 
pa Internet under fdljande adress: 
ifp.uni-stuttgart.de/publlcations/1998/CAD.pdf 
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Mer om klassificerlng finns art lasa i skriften "Automated extrac- 
tion of features from CAD models for 3D object recognition" av 
Jan B6hm, Klaus Brenner, Jens GOhrlng och Dieter Fritsch, 
(ISPRS, Vol XXXIII, Amsterdam 2000) som den 11 februari 2003 
5 fanns utlagt pa Internet under foljande adress: 

ifp.unl-stuttgart.de/publlcations/2b00/Boehm_Amsterdam.pdf 

I kallbrerlngsmodulen 17 utfdrs en basta mdjlig anpassning av 
matpunkterna till motsvarande punkter I CAD-modellen. Exem- 

10 pelvis kan f6r varje objektyta avstandet mellan matpunkter och 
punkter pa CAD-modellens yta minimeras kvadratiskt ("least 
mean square") genom translation i tre frlhetsgrader och rotation I 
tre frlhetsgrader. Motsvarande kan gdras for kantlinjer och slutli- 
gen kan avstandet mellan samtliga uppm&tta punkter pa objektet 

15 och motsvarande punkter pa CAD-objektet minlmeras for hela 
objektet eller atminstone f6r alia de ytor och kantlinjer som matts 
upp. Med denna anpassning erhalles den position och orientering 
hos objektet som bast passar de av roboten uppmatta matpunk- 
terna. Det fSrutsatts har att matspetsens TCP ar kand, liksom ro- 

20 botens nominella kinematlk. Vad kallbreringsmodulen saledes g6r 
Sr att placera, d.v.s. positlonera och orientera objektkoordinatsy- 
stemet 23 fdr objektet relativt robotens baskoordinatsystem 32, 
sa att stOrsta mdjliga matchning erhalles mellan uppmatta punk- 
ter pa objektet och teoretlska punkter pa CAD-modellen. 

25 

I ett alternativt utfdrande kan mlnsta kvadrat anpassnlngen ersat- 
tas med andra optimeringsalgoritmer, exempelvls Gauss-Newton. 

Kalibreringsmodulens funktion visas I figur 5. Objektkoordiatsys- 
30 temet 23 positioneras och orienteras relativt robotens baskoordi- 
natsystem 32 for erhallande av basta mdjliga anpassning mellan 
matpunkter och motsvarande klassificerade ytor eller kantlinjer 
hos CAD-modellen. I ett fdrsta steg kan de for varje objektyta 
klassificerade matpunkterna placeras ut f6r minsta-kvadrat- 
35 matchning av exempelvls normalvektorriktning, bankrdkning och 
posmon relativt CAD-modellen. Darefter matchas mfitpunkterna 
for tva objektytor, tre objektytor etc. samtidigt relativt CAD- 
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modeller*, till dess att minsta-kvadratanpassning erh&Hlts fdr alia 
klassificerade matpunkter till CAD-modellen. Denna metod kan 
ersattas med eller kompletteras med att kantlinjerna beraknas 
mellan de plan, fdr vllka matchnlng av matpunkter gjorts och se- 
5 dan minsta-kvadratanpassas de uppmatta kantlinjerna med kant- 
linjerna S CAD-modellen. 

Kallbreringsmodulen 17 optfmerar placeringen av det aktuella ob- 
jektet men gdr Inget at de resterande avvikelserna mellan mat- 

10 punkter och ytor eller kantlinjer hos CAD-modellen. Dessa avvi- 
kelser lagras i berakningsmodulen 18 fdr att senare anvandas for 
kompensering av robotens kinematik i justeringsmodulen 19. I 
berakningsmodulen 1 8 delas objektytorna in i delytor och kantlin- 
jerna delas in i linjesegment. Varje delyta och varje iinjesegment 

15 bdr inneh&lla minst en matpunkt fdr beraknlng av en representa- 
tlv felvektor, vars riktning Iftmpligen ar vinkelrat mot delytan eller 
linjesegmentet, sasom det deflnieras av CAD-modellen. Felvek- 
torn fdr en matpunkt ar en vektorn som stracker sig fran den 
punkt pa modeliens yta som motsvarar matpunkten till matpunk- 

20 ten sjaiv. En felvektor har bade langd och riktning. 

En korrektionsvektor beraknas fdr varje delyta. Som korrektions- 
vektor anvdnds exempelvls medelvardet av felvektorema fdr de 
matvarden som tillhdr delytan. Korrektionsvektorn langd bestams 

25 som medelvdrdet av felvektorernas langd och korrektionsvek- 
torns riktning bestams som medelvardet av felvektorernas rikt- 
ning. I fallet da kompensering gdrs fdr kantlinjer ges riktningen 
av korrektionsvektorn naturligt som medelriktningen hos felvekto- 
rema fdr aktuellt linjesegment. Samma felvektorriktning anvands 

30 dA aven lampllgen fdr angransande delytor hos de objektytor, till 
vilka kantlinjen gransar. 

Felvektorema kan vid applikationer, dar noggrannheten parallellt 
med objektytan ar viktig, aven inneh&lla laterala komponenter. 
35 Dessa komponenter raknas exempelvls ur normalfelvektorerna 
for angransande objektytor, viikas normal bildar vlnkel mot den 
aktuella ytans normal. 
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I figur 6 visas en objektyta 40 hos objektet 4, vilken ar uppdelad i 
ett antal delytor 42. M&tpunkter betecknas rried kryss i rltningen. 
En delyta 42 utgdrs av den av CAD-modellen deflnlerade ytan. 
5 Matpunkterna hamnar, beroende pa. resterande mfttpunktsfel, pa 
avstand fran CAO-delytan 42. Det resterande matpunktsfelet be- 
ror exempelvis pa kinematlkfel, transmissionsfel, gravitationsin- 
ducerad nedbdjning och temperaturberoende andring av robot- 
geometrln samt fel i TCP. I figuren visas ett antal matpunktsla- 

10 gen 44 relativt CAD-modellen efter objektkalibrerlngen eniigt fi- 
gur 5. Ett antal felvektorer 48 tas fram, vllkas langd och riktning 
bestams av avstdnd och riktning mellan matpunkterna 44 och 
motsvarande punkter 45 pd CAD-modellens yta. En korrektions- 
vektor 46 beraknas f6r varje delyta. Korrektionsvektorn beraknas 

15 som medelfelet fdr delytan, d.v.s. medelvardet av felvektorerna 
48 beraknas. 

Ett alternativ rill anvandande av delytor ar kompensering med 
narmaste felvektorn for narmaste matpunkt eller med hjalp av 
20 medelvardet av narmaste n antal matpunkters felvektorer. 

En robotbana definieras genom att ett antal positioner deflnieras 
vilka roboten ska genomldpa langs med banan. Dessa definiera- 
de positioner utgdr indata till robotprogrammerlngen. Nar positio- 

25 nerna ar definierade kan robotprogrammet genereras automa- 
tiskt. Dessa positioner kan exempelvis definieras I CAD-modulen 
15 med hjaip av CAD-modellen av objektet. Innan en i CAD- 
modulen definierad bana kan dverforas till robotens styrsystem, 
mSste banans positioner justeras beroende pa. resterande mat- 

30 punktsfel. De definierade banposltionerna kompenseras med 
hjalp av de felvektorer som finns lagrade fdr de delytor eller lin- 
jesegment som banan passerar. For erhailande av en jamn kom- 
pensering utmed banan gdrs en utjamning i form av en filtrerlng 
av felvektorernas langd i overgdngarna mellan delytorna eller Hn- 

35 Jesegmenten. 
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Figur 7 visar hur en robotbana 50. deflnlerad I CAD-modellen, 
justeras med hjalp av lagrade korrektlonsvektorer 46, vilka ar 
medelfelet av felvektorerna 48 I delytan 42. Robotbanan 50 kom- 
penseras genom att den justeras i ytnormalens riktnlng, en 
5 atracka som motsvarar storleken av korrektionsvektorn 46 for 
delytan. Genom att justera robotbanan for varje delyta erhaller 
man en ny justerad robotbana 52. Da den justerade robotbanan 
52 anvands som referens till roboten, kommer verktygets TCP att 
folia det verkliga objektets yta, sa som anvisas av den program- 
10 merade banan I CAD-modellen. 

Figur 8 vlsar kompenserlng av en robotbana 60, programmerad i 
CAD-modellen, dar banan kompenseras fdr fel I tva rlktnlngar. I 
figuren visas en fdrsta objektyta 40 och en till den forsta objekt- 

15 ytan angransande andra objektyta 64. Objektytan 40 och objekt- 
ytan 62 skiljs at av en kantllnje 65. Kantlinjen 65 utgdr skarning- 
en mellan objekytorna 40 och 64. I CAD-modellen flnns en kant- 
llnje 66 som motsvarar kantlinjen 65. Kantlinjen 66 I CAD- 
modellen justeras f6r att overensstamma med motsvarande kant- 

20 llnje pa objektet. Justerlngen av kantlinjen 66 baseras pa korrek- 
tlonsvektorerna 67 och 68 hos angransande delytor I objektytor- 
na 40 och 64. Den pa sa satt justerade kantlinjen betecknas 69 I 
figuren. Den I CAD-modellen programmerade banan 60 kompen- 
seras I beroende av medelfelet I delytans normalrlktning hos ob- 

25 jektytan 40, dvs. korrektlonsvektor 67, och medelfelet I delytans 
plan, som ges av medelfelet hos narmaste delyta hos objektytan 
64 projiceradt pa delytan i objektytan 40, dvs. korrektionsvektor 
68. PA sa satt blir banan kompenserad f6r fel I tva rlktnlngar. 

• 

30 Figur 9 visar hur en I CAD-modellen programmerad robotbana 82 
kompenseras far fel i tre rlktnlngar. En kantllnje 76 beraknas som 
skarnlngen mellan objektytan 40 och en objektyta 74, En kantlin- 
je 78 beraknas som skarnlngen mellan objektytan 40 och objekt- 
ytan 64. Justerade kantlinjer 80 beraknas i beroende av korrek- 
' 35 tionsvektorerna hos angransande delytor I objektytorna 40, 64 
och 74. I figuren visas den kompenserade banan 84, vllken ar 
kompenserad for fel I tre riktningar. Korrektionsvektorerna kan 
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antlngen erhallas fran angransande objektytor eller angransande 
kantlinjer. 

Flgur 1 0 visar ©n alternatlv utforingsform, dar kompenserlng sker 
5 medelst narmaste felvektorer I narmaste objektplan. Detta kan 
ut6kas m©d medelvardet av de n narmaste felvektorerna i re- 
spektive objektplan. I figuren betecknar 86 ett fdrsta objektplan 
och 88 ett andra objektplan. Bana 90 ar programmerad i CAD- 
modellen och bana 91 ar den kompenserade banan. Som framgar 
• 10 av figuren blir den kompenserade banan oregelbunden med 
skarpa overgangar mellan olika segment av bana. For att minska 
bruset hos den kompenserade banan och erhalla en mjukare 
bana, kan banans positioner filtreras med avseende pa banlangd. 

15 Da en bana genererad genom "lead through" av roboten ska lag- 
ras i CAD-modellen for att sedan exempeivis iagras i andra robo- 
tar, gors en omvand kompenserlng med hjalp av de lagrade fel- 
vektorema. 

20 I det foljande beskrivs en utf6r»ngsform av en metod for att pro- 
grammer en industrirobot enllgt uppfinningen. Det objekt som 
ska bearbetas satts fast I sin fixtur. Alternatlvt om verktyget ar 
rumsfast, satts objektet som ska bearbetas fast i robotens grip- 
don. Matspetsen monteras pa verktyget eller till robotens verk- 
25 tygsfaste. Om verktyget inte ar ett rumsfast verktyg. satts verkty- 
get fast pa robotens verktygsfaste. Matspetsen fdrs fram och till- 
baka dver objektets ytor och samtidigt foljer roboten med i rorel- 
sema. I en alternativ utforingsform matar operatoren in vilket ob- 
"t jekt som anvands vid kalibreringen och systemet vlsar sedan un- 

: 30 der matnlngsfdrfarandet med roboten via en monitor, vilka ytor 
som ska scannas av med matspetsen. 

;;' Robotens styrsystem beraknar punkternas positioner i nagot av 

robotens koordinatsystem.- Matpunkterna 6verf6rs till klasslfice- 
35 ringsmodulen, som klassificeras matpunkterna. De klasslficerade 

.. : matpunkterna overfdrs till kalibreringsmodulen, som berakna fel- 

vektorer i beroende av avvikelser mellan matpunkterna och mot- 
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svarande punkter pa CAD-modellen. Beraknlngsmodulen ber^k- 
rarock^bankorrektionsvektorer for de«ytor hos oblekte^Sy- 
stemet kan even under matnlngen g6ra klassif leering, kal.brering 
oc beraknlng av bankorrektionsvektorer f6r att after hand som 

5 nya objektyto? mats upp av 0 6ra nar det finns tillrackUgt med mtt- 
punkter. Ett kriterium sem vlsar att det finns tillrackligt anta mat- 
punkter ar exempelvis att standardavvikelsen vid anpassningen 
av matpunkterna till den geometriska modellen ska vara mindre 
an ett givet varde. Nar kriteriet ar uppfyllt. talar systemet om f6r 

10 operatdren att matningen ar klar. 

Da tillrackllgt manga matpunkter har matats in, beraknar syste- 
met objektkoordlnatsystemets lage och orienterlng relativt robo- 
tens baskoordinatsystem samt korrektionsvektorer for de delytor 

15 och linjesegment som genererats. Korrektionsvektorerna samt 
objektkoordlnatsystemets lage och orientering relativt robotens 
baskoordinatsystem overfors till justeringsmodulen. som justerar 
de positioner som deflnierats f6r robotens fdrflyttning. Baserat pa 
de justerade positionerna genereras automatiskt ett robotpro- 

20 gram. 

I det fdljande beskrlvs kdming av ett program genererat i CAD- 
modulen. Operatdren monterar pa processverktyget, exempelvis 
en polerrondell. De pa CAD-modellens objektytor definierade ro- 

25 botbanorna f6r TCP kompenseras med de korrektionsvektorer, 
som galler fdr de delytor som robotbanan passerar, De korrigera- 
de positionerna samt det av kalibreringsmodulen beraknade ob- 
jektkoordinatsystemet anvands ffir att berakna robotbanoma I ro- 
botens baskoordinatsystem. Med hjalp av den klnematikmodeli 

30 som ocksa anvands vid kalibrerlngen, beraknas robotens axel- 
vinklar fdr den interpolerade robotbanan och anvands som refe- 
rens till robotservot. 

I det fdljande beskrivs programmering av robotbanor genom "lead 
35 through". Operatdren monterar pa det verktyg som skall anvSn- 
das. Operatflren for verktyget utmed objektet fdr att simulera det 
arbete som roboten ska utfora. Systemet laser av robotaxlarnas 
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positioner och beraknar med hjalp av den robotklnematik som 
anvands vid kalibreringen och det vid kalibreringen beraknade 
objektkoordinatsystemet, de av operatdren genererade robotba- 
norna i objektkoordinatsystemet. Systemet justerar banorna med 
5 hjalp av de korrektionsvektorer som vid kalibreringen genereras 
for delytorna. Darigenom kommer banorna att hamna pa CAD- 
modellens objektytor och kan sedan anvandas fdr kdrhing av ro- 
botbanor genererade fran CAD, till exempel i en annan robotin- 
stallation. 

10 

Flgur 11 visar programediterlng. Operatdren pekar med matspet- 
sen eller verktyget pa ett omrade 92 av objektytan, dar proces- 
sen inte givit tillrackligt bra resultat och meddelar systemet vad 
som ej ar bra, exempelvis genom talkommunikation. Operatdren 

15 anger hur banan ska andras, till exempel "oka processkraft" eller 
sasom visas I figuren "minska avstandet till objektet". Systemet 
hamtar data fran CAD-modellen fdr de delytor eller linjesegment 
som markerats av operatdren och justerar robotbanan for dessa 
delytor. till exempel flyttar banan narmare objektytan, da djupet 

20 av poleringen ska utdkas pa det markerade omradet. Robotbanan 
94 flyttas i ytnormalens riktning i den del av banan som ligger 
inom det av operatdren markerade omradet 92. For att undvika 
att andringen bli fdr abrupt, beraknas den nya banan med en 
mjuk dvergang in i och ut ur det av operatdren markerade omra- 

25 det 92. Banjusteringen 96 lagras i CAD-systemets modell. 



Figur 12 visar matning med rumsfast TCP. Nar ett verktyg med 
rumsfast TCP anvands. ar det Inte langre lampligt att anvanda 
: robotens baskoordinatsystem 32 fdr att deflniera matpunkterna. 

30 Istallet anvands robotens handledskoordinatsystem 100. En 
. rumsfast matspets 102 anvands vid matningen. Matpunkterna P n 

(X m Y ni Z n ) uttrycks i handledskoordlnatsystemet 100. Objektkoor- 
dinatsystemet 23 definierat i CAD-modulen posltioneras och rote- 
ras relativt handledskoordlnatsystemet 100 fdr erhallande av 
35 basta mdjliga anpassning till matpunkterna. 



Figur 13 visar kalibrering av ett verktyg 104 medelst en rumsfast 
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m&tspets 102. Verktyget ar monterat pa robotens verktygsfaste. I 
CAD-modulen finns en CAD-modelf 105 fdr verktyget lagrad. 
Verktygets CAD-modell ar definierad I ett verktygskoordinatsy- 
stem 106. CAD-modellens orienterfng och position retativt hand- 
5 ledekoordlnatsystemet 100 bestams genom att CAD-modellen 
105 och matpunkterna, markerade med x i figuren, anpassas pa 
bSsta mojliga satt tilt varandra. Verktygskoordinatsystemet 106, 
som fir deflnierat i CAD-modulen, positioneras och roteras rela- 
tivt handledskoordinatsystemet 100 f6r att Astadkomma basta 
10 mdjllga anpassning till matpunkterna. Nar en rumsfast TCP an- 
vands, monteras matspetsen pa robotens handled och matningen 
utfOrs sa som visas i figur 4. Samma teknik kan aven anvandas 
fdr gripdon och fixturer, om dessa flnns som CAD-modeller. 

15 I figur 14 visas hur uppfinningen kan appliceras for en bagsvets. 
I en applikationen bdgsvets kan verktyget sjaivt fungera som 
matspets. Om svetstrAden ar fdr vek fdr programmeringen, kan 
emellertid en matspets monteras direkt p& svetspistoleh med en 
utskjutande del motsvarande svetstradens langd. Om det inte 

20 finns nagon CAD-modell, kan systemet anda med hjaip av mat- 
punkterna dela upp objektet i plan och berakna skarningsllnjerna 
mellan planen och lagga ut robotbanan i dess skarningslinjer, vll- 
ket underiattar for operatoren. 

25 Det ar ocksa mdjligt att generera en CAD-modell med hjaip av 
roboten. Operatdren mater upp ett plan at g£ngen med roboten 
och talar om fdr systemet nar han ska mata upp nasta plan. Al- 
ternate kan systemet ha den intelligens som kravs fdr att avgdra 
hur matpunkterna ska delas upp i plan med hjaip av tidlgare be- 
skrlven klassiflceringsteknik. Systemet minsta-kvadrat-anpassar 
plan med exempelvis "splines" till de matpunkter som matas in. 
De till matpunkterna anpassade planen, samt planens skarnings- 
linjer beskrivs I CAD-modellformat och laggs In i en CAD- 
databas, for anvandning enligt tidigare beskrivningar f6r kalibre- 
ring etc. Eventuellt kan modellgenereringen gdras med iteratio- 
ner, varvid i en fdrsta iteration endast ett fatal matpunkter lases 
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in f6r erhaJlande av en grov CAD-modell, varefter de tidigare an- 
vanda metoderna anvands. 

Vld kinematlkfel hos roboten kommer matposltionen uppmatt med 
5 roboten att vara beroende av verktygsorlenteringen. For att mi- 
nimera detta fel b6r operatoren da. han mater upp objektytor an- 
vanda den verktygsorlenterlng som kommer att anvandas d& ro- 
boten senare skat) exekvera banor p& denna yta. Ett satt att 
tvinga operatoren att halla ratt orientering vid uppmatnlngen ar 
10 att operatoren fdrst matar in matpunkter utan storre noggrannhet 
i robotorienterlngen, att systemet sedan gdr anpassnihg av de 
erhalina matpunkterna och att sedan operatoren gdr dm matning- 
arna, men denna gdng laser systemet verktygsorlenteringen till 
den orientering som galler fdr robotbanorna I respektlve objekt- 
15 yta. Lasningen gors genom kraftstyrning av roboten, varvid de 3 
orienteringsfrihetsgraderha gors styva medan de 3 positione- 
ringsfrlhetsgraderna gdrs mjuka. 

Robotens klnematik andras med temperaturen och flxturer slits 
20 och robotkomponenter kan behdva bytas. F6r att slippa gdr om 
den manuella framtagningen av matpunkter fdr ny koordlnatsy- 
stemsanpassning och bankompensering, sa kan det av operato- 
ren en gang gjorda matprogrammet lagras I systemet och sedan 
genereras automatlskt for ny uppmatning av objekt, verktyg, fix- 
25 tur etc. Roboten kors darvld med kraftstyrning, t.ex. i admlttans- 
styrningsmod. 

Fdra att sakra kontakten mellan mStspets och objekt kan mflt- 
spetsen innehalla en sensor (LVOT, kraftglvare, tryckglvare, op- 
30 tisk givare. virvelstromsgivare etc.). I fallet elektriskt ledande ob- 
jekt och verktyg kan aven en elektrisk krets (heist vaxelstrdm) 
kopplas upp mellan matspets och objekt. 
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F6r att underlatta for operatdren vid upptagnlng av matpunkter 
pa objektet kan talkommunlkation anvandas i stallet for knapp- 
sats och monitor. 
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Under tiden som matpunkter matas in kan systemet utfora klassi- 
ficering och "best fit" berakningar for att tala om for operatdren 
hur manga matpunkter som behftvs ffir att fa tillracklig noggrann- 
het i kalibrering och bankompenserlng. 

5 

Det skail papekas att metoden fdrlitar sig tiii robotens repeter- 
noggrannhet och ej behover dyr noggrann robot ©Her robot mod 
kompllcerad mjukvarukompensering av Mnematikparameterfel. 

10 Uppfinningon ar inte begransad till de visade utfdringsformerna 
utan kan varieras och modifieras inom ramen f&r de efterfoljande 
kraven. 
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1. Metod f6r att programmera en Industrirobot (1) att forflytta 
sig reiativt deflnierade positioner pa ett objekt (4), varvid pro- 
5 grammerlngen baserar sig pa en geometrisk modell (34) av ob- 
jektet, kannetecknad av att metoden innefattar: 

ett flertai matpunkter registreras och iagras, varvid var och 
en av matpunkterna motsvarar en punkt pa det verkliga objektets 
yta uttryckt i nagot till roboten koppiat koordinatsystem (32. 100), 
10 - orientering och position hos den geometriska modellen av 
objektet reiativt namnda till roboten koppiade koordinatsystem 
bestammes genom att den geometriska modellen av objektet och 
matpunkterna anpassas till varandra, 

for Stminstone nagra av matpunkterna beraknas avvikelsen 
15 (48) mellan matpunkterna (44) och motsvarande punkter (45) pa 
den geometriska modellen. och 

namnda definierade positioner justeras baserat pa namnda 
beraknade avvikelser. 

20 2. Metod enligt krav 1 , kannetecknad av att den vidare innefat- 
tar att: 

for ett antal olika delar av objektet beraknas en eller flera 
karakteristiska parametrar baserat pa den geometriska modellen 
for objektet, 

25 - till vllken del (20. 21) ay objektet en matpunkt tilihdr be- 
stammes baserat namnda karakteristiska parametrar, och 

namnda anpassning av den geometriska modellen av objek- 
tet till matpunkterna innefattar att matpunkter som tillhdr en viss 
del av objektet anpassas till motsvarande del hos den geometris- 

30 ka modellen. 

3. Metod enligt krav 2, kannetecknad av att namnda delar In- 
nefattar ytor (20). och kantiinjer (21) hos objektet. 
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4. Metod enligt nagot av kraven 1-3, kannetecknad av att den 
vidare innefattar att: 
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geometriska modeller for ett antal olika objekt tlllhanda- 

halls, . . 

f6r vart och ett av objekten beraknas ett antal karaktenstis- 

ka parametrar baserat pa den geometriska modellen fdr objektet. 
5 och 

till vllket av objekten matpunkterna tillhor bestammes base- 
rat pa matpunkterna och namnda karakterlstlska parametrar. 

5. Metod enllgt nagot av kraven 2-4, kannetecknad av att 
10 namnda karakterlstlska parametrar Innefattar normalens riktning 

(26) relatlvt objektets yta och kroknlngen (25) hos objektets yta. 

6. Metod enllgt nagot av fdregdende krav. kannetecknad av att 
den geometriska modellen av objektet och matpunkterna anpas- 

15 sas till varandra genom att avstandet mellan matpunkterna och 
motsvarande punkter pa den geometriska modellen av objektet 
mlnimeras. 

7. Metod enligt nagot av fGregaende krav, kannetecknad av att 
20 objektets ytor delas In I ett flertal delytor (42), var och en Inne- 

hallande Atminstone en matpunkt, fdr delytorna beraknas en kor- 
rektlonsvektor (46) baserat pa avvlkelsen (48) mellan matpunk- 
ten/matpunkterna I delytan och motsvarande punkt/punkter pa 
den geometriska modellen av objektet, och att namnda definiera- 
25 de positioner justeras baserat pa korrektionsvektorerna for de 
delytor som positionerna tlllhOr. 

8. Metod enligt nagot av fdregaende krav, kannetecknad av att 
objektets kantlinjer delas upp i ett flertal llnjesegment, vart och 

"{ 30 ett innehSllande atmlnstone en matpunkt, f6r linjesegmenten be- 
raknas en korrektionsvektor baserat p& avvlkelsen mellan mat- 
:!/ punkten/matpunkterna i llnjesegment och motsvarande punkt- 

/punkter pa den geometriska modellen av objektet, och att namn- 
-}} da deflnierade positioner justeras baserat pa korrektionsvekto- 

35 rerna for llnjesegment I narheten av de deflnierade positionerna. 
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9 Metod enligt n&got av fdregaende krav. KannfltecKnao; av att 
namnda matpunkter motsvarar robOtens positioner nlrwffcj 
bestamd punkt pa ett verktyg, eiler ett matorgan (14 som mot- 
svarar aktuellt verktyget, star I kontakt med olika punkter pa ob- 

5 jektets ytor. 

10 Metod enligt nagot av fdregaende krav, KfirmQtecknad , av att 
namnda definierade positioner ar definierade reiativt den geo- 
metrlska modeilen och att de definierade positionerna transfer- 

10 meras till namnda till roboten koppiade koordinatsystemet base- 
rat pa den bestamda orlenteringen och positionen av den geo- 
metriska modeilen reiativt det till roboten koppiade koordinatsy- 
stemet. 

15 11. Ett datorprogram dlrekt inladdningsbart i en dators tntern- 
mlnne, innefattande instruktioner for att paverka en processor att 
utfora stegen i fOrfarandet enligt nagot av kraven 1-10. 

12. Ett datorlasbart medium innefattande ett datorprogram inne- 
20 fattande instruktioner fdr att paverka en processor att utfora ste- 
gen i fdrfarandet eniigt nagot av kraven 1-10. 

13. Ett system for att programmera en industrirobot (1) att fttrflyt- 
ta sig reiativt definierade positioner pa ett objekt (4), varvld sy- 

25 stemet Innefattar en geometrisk modell (34) av objektet, fe anne- 
tecknat av att systemet vidare innefattar: 
det verkliga objektet (4), 

en industrirobot (1), varvld det verkliga objektet och roboten 
ar anordnade sa att det ar mdjligt att medelst roboten generera 
30 ett flertal matpunkter motsvarande olika punkter pa det verkliga 
objektets yta uttryckt i ett till roboten kopplat koordlnatsystem 
(32. 100). 

en kalibreringsmodul (17) anordnad att bestamma orienter- 
ing och position hos den geometrlska modeilen av objektet rela- 
35 tivt namnda till roboten koppiade koordlnatsystem, medelst an- 
passning av matpunkterna till den geometriska modeilen av ob- 
jektet, 
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. en beriikningsmodul (18) anordnad f6r berakning av avvi- 
kelser (48) mellan matpunkterna (44) och motsvarande punkter 
(45) pa den geometriska modellen, och 

en justeringsmodul (19) anordnad att justera namnda defi- 
6 nierade positioner baserat pa namnda beraknade avvikelser. 

14 System enligt krav 13, K^nfttacknat av att systemet inne- 
fattar ett matorgan (14) anpassat fdr att vid matning sta t kontakt 
med objektets yta, varvid matorganet har en centrumpunkt som 
10 motsvarar verktygscentrumpunkten (TCP) for aktuellt verktyg. 

15. System enligt krav 14, ^nnetacknat av att matorganet.(14) 
ar inrattat att vid kontakt med objektet avge en signal och att sy- 
stemet ar inrattat att som svar pa denna signal generera atmln- 

15 stone en matpunkt baserat pa robotens position. 

16. System enligt nagot av kraven 13-15, kannetecknat av att 
systemet lnnefattar en delklassificeringsmodui (16a) anordnad att 
f5r ett antal olika delar (20, 21) av objektet berakna en elier flera 

20 karakteristiska parametrar baserat pa den geometriska modellen 
f6r objektet och att bestamma till vllken del av objektet en mat- 
punkt tilihor, baserat pa namnda karakteristiska parametrar, var- 
vid namnda kallbreringsmodul (17) ar inrattad att utfdra namnda 
anpassning av den geometriska modellen av objektet till mat- 

25 punkterna genom att anpassa de matpunkter som tlllhfir en viss 
del av objektet till motsvarande del hos den geometriska model- 
len. 

— . 17. System enligt krav 16, kannetecknat av att namnda delar 

7 30 innefattar ytor (20) och kantlinjer (21 ) hos objektet. 

18. System enligt nagot av kraven 13-17, kannetecknat av att 
systemet vidare innefattar geometriska modeller for ett antal oll- 
;": ka objekt och en objektsklassificeringsmodul (16b) inrattad att for 

■< 35 vart och ett av objekten berakna ett antal karakteristiska para- 
O metrar baserat pa objektets geometriska modell och att bestam- 
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ma till vilket av de olika objekten matpunkterna tillhSr, baserat pa 
matpunkterna och de beraknade karakteristiska parametrarna. 

19. System enllgt nagot av kraven 16-18, kannetecknat av att 
5 namnda karakteristiska parametrar innefattar normalens riktning 

(26) relativt objektets yta och krdkningen (25) hos objektets yta. 

20. System enligt nagot av kraven 13-19, kannetecknat av att 
nSmnda kalibreringsmodul (17) ar inrattad att anpassa den geo- 

10 metriska modeilen av objektet och matpunkterna till varandra 
medelst minlmering att avstandet mellan matpunkterna och mot- 
svarande punkter pa den geometriska modeilen av objektet. 

21. System enligt nagot av kraven 13-20, kannetecknat av att 
15 namnda justeringsmodul (19) innefattar medel for att dela upp 

objektets ytor in i ett flertal delytor (42), var och en innehallande 
atminstone en matpunkt, och Justeringsmodulen ar inrattad att for 
delytorna berakna en korrektionsvektor baserat pa avvlkelsen 
mellan matpunkten/matpunkterna i delytan och motsvarande 
20 punkt/punkter pa den geometriska modeilen av objektet, och att 
justera namnda definierade positioner baserat pi korrektionsvek- 
torerna for de delytor som posltionerria tillhbr. 

22. System enligt nagot av kraven 13-21. kannetecknat av att 
25 namnda Justeringsmodul (19) innefattar medel for dela upp objek- 
tets kantlinjer i ett flertal linjesegment, vart och ett innehallande 
atminstone en matpunkt, och justeringsmodulen ar inrattad att fdr 
varje linjesegment berakna en korrektionsvektor baserat pa avvl- 
kelsen mellan matpunkten/matpunkterna i linjesegment och mot- 

30 svarande punkt/punkter pa den geometriska modeilen av objektet 
och att justera namnda definierade positioner baserat pa korrek- 
tionsvektorerna for linjesegment I ndrheten av de definierade po- 
sitionerna. 
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23. System enligt nagot kraven 13-22, varvid namnda definie- 
rade positioner ar definierade relativt den geometriska modeilen, 
kapnetecknat ay att namnda justeringsmodul innefattar medel for 
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att transformer namnda definierade posltionerna till namnda till 
roboten kopplade koordlnatsystem, baserat pa den best&mda ori- 
enterlngen och posltlonen av den geometriska modellen relativt 
namnda koordlnatsystemet. 
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SAMMANDRAG 

En metod och ett system for att programmera en industrlrobol (1) 
att fflrflytta slg relativt definlerade positioner pa ett objekt (4). 

5 Systemet innefattar en geometrlsk modell av objektet, det verkll- 
ga objektet, en industrirobot. Ett flertal matpunkter genereras 
som motsvarande oilka punkter pa det verkllga objektets yta ut- 
tryckt I ett till roboten kopplat koordinatsystem. Systemet innefat- 
tar vldare en kallbrerlngsmodul (17) anordnad att bestamma ori- 

10 entering och position hos den gedmetriska modelien av objektet 
relativt namnda till roboten kopplade koordinatsystem, en berak- 
nlngsmodul (18) anordnad f6r berftkning av avvikelser mellan 
matpunktorna och motsvarande punkter pa den geometriska mo- 
delien, och en justeringsmodui (19) anordnad att justera namnda 

15 definlerade positioner baserat pa namnda berdknade avvikelser. 



(Figur 2 ) 
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